#include "ros/ros.h"
#include "epuckDriver/CommandSubscriberMsg.h"

int main(int argc,char **argv){

    ros::init(argc,argv,"comandTest");
    ros::NodeHandle n;
    ros::Publisher pub;

    pub =
n.advertise<epuckDriver::CommandSubscriberMsg>("epuckCommand1",1);    
    epuckDriver::CommandSubscriberMsg cmd;
    
    cmd.twist.linear.x = 0.5;
    cmd.pose2d.theta = 0.707;


    while(ros::ok){   
        pub.publish(cmd);    
    }
   
    return 0;
}
